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^si± ojjii mm 



(54) [|gl»0!>«li:] |i|»l^lBljS$g(g 

(57) ismi 

fi« 2 oj.x±?¥a-r 1 (Di+agu 3 s r-gisu 

±??ffi -r 5 Ji^^m 2 ©ttagp 3 9 Tissu L. m 1 0ft 

Sk^S 8 T'S^&f^Jb^m 1 <DS^^M^rc@S!|^]!>^2 
OJJ(±» y . 2 rottKSP 3 9 Tmk^ t «>!Bat*i< 

m 2 <DS*ffl^S*/ci4^%)6'' 2 oW±»^ <!: * S^tt 




(2) 



^tBI¥6-1 3 8 941 



±^r^m-^^miT^fs 2 ottaaptx 

«!te3b^ 2 otx±^ t) f'-om 2 (Osm^-^mmvo t <7>sgi 
tm 2 (Dmrnm^m^fcMMiWij'^ 2 oj.x-h^s t ^ 

[000 1] 

[SSI±<3!)5pJffl»5] h&^lHt 
[0002] 

^g^c•p^,^T« jtPAtiltPva - 1 3 9 2 7 y^tcjj 
[0 0 0 3] i::tn*BS%KD^5^isErtlc77'>>-<«^ 

[0004] 

i^mmiii L J: -5 1 -r «^S] 

feBllSji^JS < JS: o J: -5 4#^^»!l§^C*J^,^T^*lHl5a^!)f^ 



[0 0 0 5] ntntmTHt. 02 2ic/T^x-r<fc-5iczr-;u 

1 0 1 izf^ti'o^mw 1 0 2 ;E>'«i}^A'6 < 

1 0 3. 1 0 4*lHlj8LTl.''Sttjg*5^U ^Wi»^ 0 

2. 1 03. 1 0 4<3!)ll3tLli-«iJ«!:LT5-9-V:7^y>^^ 

[0006] C (D^iJTHii^filfi!: 1 0 2 tf^^SlfSSKb 1 0 
[0007] 

t. [©s*!!lSS<D/c4&cD7';^dr«^Xlk«ffit^»^tslas 
[0008] ^2 a>¥tmmmM^mt'^m i <DS*<i« 
^(DB^WlS^t. nm'iiiiit<Dmfenfim2<Dsmm^mxrc 
m 1 ©n-agiJT'iBggfeKSA^m 1 ajsp^jS^rcisi 

2 ODSifHS*®;^/cJ*^%*^ 2 OJ.X±^^ <»: 
[0 009] 

[0 0 10] fS2<o^miis m^<ommtmx. m^M 

[00 1 1] 

tt3i«iasyrs*eiJi^^SB2. wssfeKSipJS^iai 
^mi^^iftzsmhr^o'^^. ■r«:fe-6a<i%i(«:rpi6^t'> 
S3 1 tew ens, 

[0012] ^ LTmm&m. 3 »m;t«tJiU:<o^i^=& 
[0 0 13] m^mmL^\'&mm^^t. ^imtm^r 



(3) 



*tBi¥6-1 3 8 941 



^iRi«ai^iia5i lis •?-©«sai«#«iii»sas<Dfc46 

[0 0 14] $fcs ^mmc^r^mm^m^tcttxD^ 
r^^momm • fins^istHsiiiB 1 3 1. ^<o%m^ 

[0 0 15] MIC. fJ3SL/j:#:*7C^>/<f5/'y:/Bia=& 
iBIi Lfc$:*7L;'< >/^> >y TJ^MSflBtigp 1 5 i»© 
2)t ♦ S£Is]ftSW-;lJ^B 1 3 <)^6<Dt+ayfi^tCfSi;T. 

$;^?7cp< >/^> ymmm^ 1 5 ic*s*a* ti/c^:^7c 

[0 0 1 61 ^-tDfiAHC. (i^^JftilSI 2©aj^. # 
^^W^—Vy^MStlBtSasi soffits tt-Jl^aS 
H2tDllS^tCj:y«3gfeKJg^»©-r*C PU 1 7. 31 

1 8 S^tiATt">^o 

[0 0 17] S3g/gl$JS¥J£iliB1 (C^lNTs 

nSo $ /i:<i#S«lSB 1 2 li. sg*!a<DfitH • mm ' 
jii75?iR]«iai^s 1 1 f^e>m'E>nrcmmmcmr^m^ 

So 

[0 0 1 81 ^fc. g»(^s^-iSEiHiftigttay^si 3 
ip<7)fh3i!isT«i^*tiSo m^taEftsmi 4^. -tns 

[0 0 1 91 $;^c7cp<>/<->y:/MaiBtigi5i ^ 

iss* tis^^xjTc;^ yBiiB[«iBti-rs^ * u v 
mm^ti^o c p u 1 7;&cfs^/a[^ys^ssi s 

[0 0 2 0] «2gfeK)SI3tSg|53 1 (cJ:oTiBti*4ifc 

<ji»as^^i$iS:()«stp«i«jis^S}t^Si«bt(-fi(as3 sic^ 

SJ>t^*!!IttagI53 9ttemtPi^*ilF^iE8t*!«»lpffiJ-X± 

;Udf'Ji*(DSM7';L'dr'JX/:.fB1ggP4 0«©*%)<Da*s 
J: -3 T ^05 J: -5 ^0® ^tr o fc 6 St^ib^ i: t^ 5 



[0 0 2 1 1 lHl)aBff<DfcA6£D*y{ai^lB3 lis ^tbf*© 

[0 0 2 2] s/c. '^m(oj:oicmmm^simr^tztt> 
s» (»i!iajSst«t?f^iRj=&5^-rft)S) «w 

jiiestiiT'yi/df' J xzxiB^gp 3 4 s ffigsfet^jsiBtigP 3 

ISI^,-^5<Da53gfeK)g33J:tfB:^MjStilS«aig513 2 

T'«sai*n-5Bi^fttBtca^*s isiS(7)rc«)©it?73?iR) 
• jSjgmai7';nryxL.i3«ffl53 4icttiw*nfc7'/nr 

ajfSC PU 3 Si:. CtDC PU 3 5Tgai*tL/i:/\°^ 

;^ — 51 6^ e ^S!i4!i^iHiie-r saf^^n^-r *®jiaiji<^«- 
al^D■rsJl^T*IRJfe«^:tfiiJet^:ot^T<^^|J^Bl^g^a*sl 

S3 6ti^Tt^%o 

[00231 cpu37ti. m^^^ii^smm^mx 

^nWintmrn 3 9 T-W-St L fc e eS%lF^^g6*i«S 

dr'>>XAKiSSP4 0 lcSBtt*nTt''S7';U:J'J XL.JC J: 
oTl2l5B7';Udr'JXL.©SM7';HJ'JXAI31tS3 8© 
ZiUdTU X/*«1giE-rS<fc 3 left oTt^So 
[0024] ttjJE^DSlia 2 ««2EO«fc 5 (Cx 311^^ J: 

'J XA^^SSfl LfcttJa^llT'yl'df 'J XAiBtsap 2 1 

*v «-^^sy7';i'=r'jx/*i3tia52 1 ic*s$ft5-nfc7'/i/ 

Xi*tcS£oT«SI/BKSfiO^^<B«^Stai-r*C p u 
©CPU 1 7ltjMe.tlS. 

[0 0 2 5] ftfcs 01 <Dfe^!te0>s^§*«SfiK'r*3 
o(D#iaa)S>«7tc^«n*cpu 1 7. 22. 35. 3 

7 1*. / \- K-? I Z t LTtt 1 o<© C P U T'««* tlx 

«ti.S, c:(3!)J:-5lc«fiK*nfc^SWv CPU 3 71!:* 
o TPS*%l*lelS'r S J: -5 tC7'/l/=f 'J Xl^36i«j*«>6ns 
^•©3i«>6+i/c7';UrruXA<ts a^iiM;S(fiS«5ai^ 

S3 2TiKai*nsa*i<as{i^<!:icstoTc p u 3 5 

[0 0 2 61 ii(D«Ae(c<):t>. m(£S3^/B(^;b^0. 
ifUXAlcJ:*itif^Ai«§ltT*n%c:<i:l£:ft*o 02liflfi 



(4) 



^BS76-1 3 8 941 



[00271 la 3 14E 1 (D^S<Di(lf^*/X.r^JT'» U x 

«yi{.Mrgs^/gi$js«(o. 6Je(±(DP$S!|^ti(2^j^±£$ 

»JL. ^<D^iJ!ie^H:fifoT*J{a)^S3T»S*!slH]S<7) 

[0 0 2 91 it-r. tB3gfel«jeWS#Sl ^^:3SL^T«gg 
at;jiS#S6^6m«3?5C7uffiMrtlc. BI4tcS^-r«»:3* 



[0033] *fcx tx, ty^c•:^t^T©y>/^>•>:'^M 

at*. =i:tv^tVk<0 (3) . (4) iC©<fe-5lc^*o c 

= / <x) =expj J 

[003 5] 

y > =e'^p[ ^7 — J 

[00361 X - t x»i®±fc"<fe y - t yK®±T1*. 

+ rx. Ry+ r ylcftSa)T» 

,=exp[ J- 

[0038] 
[0 03 9] 



[0 0 3 0] EttJOlB^ti. J.XT<^<t3tC^a*n«o 

F (X, y, rx, ry) = 0 : l|jS^jett®St!tJrt*JBtt 
tx=f (x) : X- txfflt!:J5it5oyffiS;^yy^>y 
ty=g (y) : y-tyffilciiW-S-:>y»iay>/^>y 

ax : xtC'3L>T<D>'7'i?'f • XV hntf— tCJtffilf S 

ay: ylc-^CTO^yv^V • x> hPtf— icikffilfS 

rx: ffjtcDiS (x, y) *^€J^)l^)g!|giii^fi 1 
05l?iS^Jgi^i:(0. X - t X l/r®±T'a5ffilll 
ry: ffijSO!)^ (x, y) ^^trflji^lgSgtil^lS 1 
<7>«l^Jg»tO!). y - t y »riB±T<DffiJ8l 
t : 3:^CTcP<>/^>•y^»^c«J:oT#^6tl^^ 
(x, y) CDii^JS 
WIS<DffiS±, S'&JSt^tx. t ylC»ttTIEa-r« 

6^. t. tx. t yti»SI±|5)— <Offi«IWT-SSo 

[003 1] CKDi*. fftcWiii (x. y) «#t>^il 

[003 21 
[S(1] 



.... (1) 

[0034] 
[SK2] 

.... (2) 

[»3] 

.... (3) 

[00 3 71 
[3^41 

= e^p[— fj-] • • • • <4) 
[»51 

• • • • (5) 

[»61 



(5) 



3 8 941 



t =exp 



(-(Ry+ry) + RvP 





rv2- 


=sexp 






. ay' . 



[0040] 



^=ayV— fin t 



[004 1] 



[a7] 

[»8] 



[0042] 



(R«+axV-ftn / )= Ry+flvV-fin < 



-1=0 



(6) 



(7) 



(8) 



[»9] 



(R*/a«+V- fin < R^/ay+V-fin < 



— 1=0 



(9) 



[0 0 4 31 cKoi:*. m^mtm2m<oimo o « 
^i<lRll;mT3S:t^^:. t icot^TomrasctcttasmT^ft 

min(Rr/ax. Ri,/ay)=s« 
[0 0 4 51 ^^tt>. O^s^sk (Omif'^M^^s 

Rx-dx _ Ry-dy _^ 

[0 0 4 7] (t&Sdx, dyS^5R46So riSit>-&. 
[0048] 

[0049] 

d y=Ry— a y S 

[0 0 5 0] ^^tt>. mm^mmo)mm^'!fGX.oi:'?ic 



[0044] 

[Ski 0] 



[00461 

m^ 1] 



[»1 2] 

[»1 3] 

[005 11 
[1K1 41 



(10) 



(11) 



(12) 
(13) 



{(R,-cfr)/ax+V-8n t l"* (R,-dy)/a,+V- Hn f 



[0 0 5 21 CCT'v S^©-»X3ti«iEffiJ©®». +» [0 0 5 3] 

xi!«&«iJ©SI5»««t3-rc 51 

(s+V-Bn < )^ s+V-fln ' 

[0 0 5 4] C<OiC<'!)3a<Pl^W*«'*=&E15lCg^-ro * [0 0 5 5] 

SSdiSatoLTt^S. (1 6) ^J:t) 



-1=0 



(14) 



(15) 



4(1x1 -dx)' (y-Kdy)' 



y + dy 



[00561 
[0057] 



vs+V-fln < >0 



[SHI 71 
[ftl 8] 



(16) 
(17) 



(6) 



^mW■6-^ 3 8 941 



|l f / 4( I y I -d,)' . [y + i 



- s 
(18) 



[0 0 5 8] {SL I X I <dx©<!:#x = dx, lyl< 
dy©<t* y = dyi LTItW-r-So 
[0 0 5 9] BI4«:}<i:3lc. itsr^^jS^ISiiS 

[0 0 6 0] t^mzLx. nmrzmm^mtsiifim^m 

*o flU COlf^. fiittO^-^S (x, y) A^jSiKLfcIf 
I y l<dyT% 0 rt»iEG>fiilc4y. «(«!J«aaP5JH: 

[006 1] m^s 1 a)a!K3iisa)(*9ffliJ (xt*ii-fly) 



[0062] -Ijs b5IBcd 3 5X:7caf%ii!S;'« >/ ^> 

[0 0 6 3] B^jeioart&ssjw^flyicfcL^T 

X, yCDiS^JStt 
[0064] 
[SCI 9] 



< x=exp 



{(x+dJT(R,-dJ}= 



r ( \x\-d, Y 

J=exp[-[s 

(19) 



[006 5] 



[0066] 



[|gt2 0] 



(20) 



t >=exp 



exp 



[33(2 1] 



:exp 



[-(^^11 



[006 7] 



/ y+dv 

.'. s +V-fin ty= 



[0 0 6 8] mmic. m^m i (Dwmmoifimic'oi^T 



it 



s — V— Bn <x=- 



[0070] 



[S)C2 2] 



[0 0 6 9] 
[&23] 



' <21) 
(22) 

(23) 
(24) 



[007 1]iJfoT^ Cila6<fcy35(t^<D<fe-5«:^fi8aiS [0073] 
iC*i'«»6tX5. [Sk2 5l 
[0072] (A) JfeWSfliJ (y<0) 

I xOt,=exp [-{| (V4(slV-»n t.)'+(s4V-ln tJ'+(s±V-»n tx))-s}^] 

.... (25) 



[0074] {B) mm (y>o) o>m^ 

[007 5] 



[»2 6] 



(7) 



1tBBV6-1 3 8 941 



[0 0 7 6] o»^m;ii» (cy^Lifx ftSQ) ^yxx-riB 

[00771 «#C!>itI*». +««iS^lg 1 (OttltollKD^ 

[0078] fiU I X |<dx<7>t* tx= (tx) 
x=dx. I y l<cly(Di*ty= (ty) y=dy<!:LTH-S 

ii!»aJ*^T^fi83-*i«t*tt. I X Kdx I y I 
<dy T\ O mitiEOyimctsi)^ SMftUKSU^T^^* 

[0 0 7 91 y>-Ry, I X KRx (Xtty<- 

Ry, I X i>Rx) ^cfct^Ttx, tyt^^—m^cm■^m^ 



t =exp 



.... (26) 

[0 0 8 0] ±iBO!)#<aaiSSicj:y. sf*ss{<^^>/^ 

[0081] ;^(jic, ±fB© 3 ?R7ctt*Si«8;>< 

[0 0 8 2] iin«> E6(DJ:3^^RW»%i®ii:J:* 
IBS^SffiomfiKT'Sy. JJtT®J:5* (n + 1) :*7i 

«f!te^sp<>/^>•y^s»^: (n + i) ^tcSWSbS^^ss 

[008 3] 
[»2 7] 

21 



— s 



(27) 



[0084] 

•HLv O^s^sk. sk=inin (R i/a i) 
di = Ri — aj s 

I xi I <di0i:^ xi = di<tLTW-»-r?.o 
[0 0 8 51 0 f*it'^iE(Dt^. Atn^mi 



(A) Jt^i (xn<0) 
[008 61 
[»2 8] 



(29) 



[00871 (B) iSffitJ (xn>0) (Dig^ 
[00881 



[»2 9] 



,=exp [-{^ (V24(stV^lFTr)^(s±V^^lfrt7)^- (s±V-ln t«))-s|''j 



(29) 



[0 0 8 9] +t'^m^m.^ <omm(r>9\- 

fig. -fi()S^JSlOtS^HsS<0l^fi!lT'£«. 
[0090] 

•fiUx 0<s<sk, sk=niin (R i/a i) 
d i = R j — a i s 

I Xj I <di©4:*t j= (tj) xi=di<!:LTH-»r 



[009 11 0 l#3fi«IEOi*^l«ffl!B^ffl!l 
0 rtft^ftOt^Rtf^T® I Xi I <di®<!:*» 

[0 0 9 2] CC:T-3-^C7C<D'fe©lC-Pt''Tli'^®<fc-5lC 
[»3 0] 



(8) 



ItHVe-l 3 8 941 



t=exp 



' (30) 



[0 0 9 3] MIC, Wl'^ii§i(0'P'\>a>iSLSi3'^ (A. B) . 



[0094] 
[»3 11 



t=exp 



ay'' 



ay 



(31) 



[0 0 9 5] {iU 

X= (x — A) cos<p+ (y-B) sin<p 
Y = - (x — A) sin<p+ (y-B) cos(p 



etmSifi^m^t LTx Rx=Ry=0. s=0. <p=0 

[0096] 
[»3 2] 



=-[-{i(V^(^?NU-ir)F] 



<32) 



[0 0 9 7] ^:<D^Tato^tl5-^y^ilip<>/^>•y:^ [0 0 9 9i 
Karomtt^ia 7 ic5^-r„ [a 3 3 ] 

[0 0 9 81 ^fiK-SISiCli 

t .0 f v= e xp l^-jy (V-4 in t.-tn ty ±V-ttn ) }^ ] 



(33) 



[OlOOlffl^t*. y*i«iEfflJ©<t:*-«-atf, yfl«ft 

[01011 Pitiii: (n + 1 ) ^5c7u^cfet^Ta%**e* 



«exp 



[0 10 2] 
[»3 4] 

2I 



(34) 



[0 1 0 31 



m3 5'i 



O / I = e xp [-{|- (V-M an t,-in f„±V-fin ) ] 



(35) 



[0 1 0 41 xnt^mmot^-^mifs xnt? 

(JfeiffiffliJ) ©i:^-+*S.5Co CCT\ i^iJj«:©«y<!: 

LT, Ei8tc^-r<i:-?icJF®±^^ib*fTt-saa2im^ 
a)^i7*4o*#iiSo cnti, fiy:S.if:s^iRiS8iffl© 1 

<B£0Butit4 1 ie»ffl(02<i©«lft4 2, 4 3 t*IS^ 

^«4 0<0iitf@4i(0(as(cB$x £fTm4 0(08i))ir 
«^iRi«y«fr« 



[0105] «?7m4 0««JiAL«J:-5frS 

HlgE (255i:7c¥S) rt(c^5f^*!fSs<i:<D«^©feBI* 

±i3o>^yas<DS«aiip«>/<->y:^Ma (07) 

(3 4) ^J:U. «5gfel«Jgdtt:^<DJ:3lcato4-n 

[0 10 6] 
[»3 61 



(36) 



[0 10 7] ±^T' 

X=+ {x-f (v)sine} cose+ {y-f (v)cose} s 
Y = - {x-f(v)sine} COS0+ {y-f (v)cos©} c 



OS 6 

[0 10 81 d : ffi^^f^is m^m.) 
f (v) : m^m^ (feKS3{j« 1 ictjii^m) 

f (v) = A V : ^^T»<J52« V (CJtey L T/bBI«JIE«I£ 



(9) 



nmW■6-^ 3 894 1 



f (v) = A V 2 : mjmomm v o 2 stc jt«y ltsbi 

ax. ay:fel«tUa<D*#*«ISS-rS/<5^-^' 
[0 10 9] ±IB<D^ (3 8) tt<fey. ^t7m4 0©ji 
L * 5 <t r SlifiElcfcnt SffiggfeKS d *^«>« t . 
E9StfE1 0(0J:5lc*So c:n'5©0rt*s ±13© 

<t 5 S 3 :^C7ctt!fl!!ii!g;'< >/ ^> ygias^St^* c <!: (c J: 

^fc. E5'x©Tiia[*3lCi^ift'rS^I|!|!!i)5 0 6'« 

mm^ 5 0 i:.^io^mm-^wm(Dmif' (ei 9 ©Ji^d = 

0. 2> Ell 0<DJg^d = 0. 4) T'Sto^tlSo 

tOtU ^-SBS-S (JKffiB§SiJ) «'t = tOx HhIbJO) 
+t>'7^UV-J^BtSij:£t = t-i«!:-rs<!:. I2l9»t = t-i 
(c*J+««^feKSd-i*«t)U iai0ttt = to»^ 



[0 1 1 11 Mit. ^ffi^sij t o6^6 1 iii«©+t>yg 
vy^sj^ti^r^ix El 1 atrial 2ttti=to 
+ d wzisii^mmm^ (^safii) di ^m.t>-t, w 

[0 1 1 21 ±.i^(Di»wmmm5o\t. K^n/cssfflrt 

(5» ^^ini t = t OlCfeJtSJtff^lRHtra^iS t = t o«> 

JlJgTt?31ilJ^)li!)^-r*t.<D<!:i5^LT> ti=to+ 
d t Icj3lt5j^ifi©§%l5 0<0ifiS«*«>5o ■?■ 
cD(aH«4''i>i LTx 1 0*^6 t iCDPao^i»ffiSHcJt«U 

:7 7' e>V «^©iic(*« r t = 1 1 = 1 0+ d t ic*5t^T^ 

l!lKS*!a5 OttJI©»rc»>»lC3l5Sr£5-5J tt^^s 
[0 113] 

[a3 7] 

• • • • (37) 



[0 1141 ±SCT 

X = + (x-xp) cost/;+ (y — yp) sin(/; 
Y = - (x-xp) sinip+ (y-yp) cos(/^ 
[0 1 1 51 p : rc(7)»/!:yiC3R«^5-5j 

CD t = 1 0+ d t \Z^\-t^\SLW.<0 X IffilH 

yp : mtmmm'^mmmi^Wi^r^t.isc&i^tzi^t: 

(D t = 1 0+ d t icJsttSfflSO) y JH^ 
[0 116] apx, apy: )f|R1SlsEa)***«J*46* 

vp : t = 1 0 \.zt5\>f^nwmm^<Dmm. 

[0 1 1 7] CCOJa^. t = to*''S t = to+d t(OFa 

D = d,+ (do • di)^ +(<i-i • cfo 
[0 1 2 11 ±SCOlB2]Si:»3«l*. d-i. do. di 

ICjfil^fitSlc???! Ll!^l+«li$tC»» » 2 ^<t » 3 ««« 
[0 12 21 ijScJc. m^m&a>tcisbaiWSm^-^'^>i>^ 



jittsissiiv t = 1 0 ^ci5^^sii^T^IpJ«as®M^ 

[0 1 1 81 ^LTx B5KE<Od:-Pl!:feK^teJ*afe-r3 

^ufiidi trs. 

[0 1 1 91 ±IB03-3<D«5gfeBSlSs -Tito's 
t = t-ilt*5ltS«^feBlJtd-ii: t = to »J:«5t:^«§5 
ggfeKJgdo tt = to+dt Jc*>»ti>SBS5feKSJS 

[0 1 2 01 
[|![3 81 
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(54) OBSTACLE EVADING DEVICE 

(57)Abstract: 

PURPOSE: To satisfactorily evade the obstacles even in such a state of 
emergency where the risk of collision is increased to plural obstacles at one time. 
CONSTITUTION: At first a 1st counter part 38 identifies a case where the 
collision is evaded to the obstacles based on a certain algorithm and two or more 
obstacles have risk of collision higher than a 1st reference level. Meanwhile a 2n 
counter part 39 identifies a case where two or more obstacles have their 
distances larger than a 2nd reference level. Under such conditionsa deciding 
means 37 decides a faulty state. Then a control part 35 changes the algorithm in 
the faulty state in order to invalid the control to travel to a target point and to 
completely evade the obstacles. 



CLAIMS 



[Claim(s)] 

[Claim 1]An obstacle avoidance device which runs to a target spot while detecting 
danger of an obstacle which gives danger to on-going vehicles toward an object 
characterized by comprising the following for every predetermined forecast time 
and avoiding danger according to the danger. 

A situation [ of identifying a specific situation based on the degree of near 

collision to two or more moving obstacles ] prediction device. 

An avoidance-control device which uses an algorithm for obstacle avoidance 

properly. 



[Claim 2]An obstacle avoidance device which runs to a target spot while detecting 
danger of an obstacle which gives danger to on-going vehicles toward an object 
characterized by comprising the following for every predetermined forecast time 
and avoiding danger according to the danger. 

the 1st calculation that identifies a case where two or more object obstacles with 
which the degree of near collision exceeded the 1 st reference value exist — a 
part. 

the 2nd calculation that identifies a case where two or more subjects in which 
distance with a subject exceeded the 2nd reference value exist — a part, 
an obstacle with which the degree of near collision exceeded the 1 st standard by 
said 2nd coefficient part — those or more with twoand the 2nd calculation — a 
decision means to conclude that it is an abnormal condition when there are two or 
more subjects in which distance with a subject exceeded the 2nd reference value 
in a part. 

A control section which changes an algorithm so that control which advances to a 
target spot may be repealed and it may be devoted to evasion of an obstaclewhen 
said abnormal condition is concluded. 



DETAILED DESCRIPTION 



[Detailed Description of the Invention] 
[0001] 

[Industrial Application]This invention relates to the obstacle avoidance device 
which avoids the obstacle which encounters while a mobile robot or an automatic 
guided vehicle runs. 
[0002] 

[Description of the Prior Art]About the device which avoids the obstacle under 
stillness or movementthe applicant has proposed the method of using a multi- 
dimension membership function in Japanese Patent Application No. No. 1 39277 
[ three to ]. 

[0003]By this setting up the multi-dimension membership function with which the 
goodness of fit of a f-set can be expressed in a field with an obstacleand 
computing goodness of fit using the multi-dimension membership functionit asks 
for the degree of near collision in a fielda control command for the mobile which 
moves from the value of the degree of near collision in the inside of the field to 
avoid an obstacle is generatedand it is made to output. 
[0004] 

[Problem(s) to be Solved by the Invention] Ho weversince such a conventional 
method has opted for avoidance operation with the algorithm fixed regardless of 
the number and position of a moving obstacleThe case where a collision is 
nonavoidable as avoidance operation becomes insufficient in an emergency when 
the degree of near collision became high simultaneously to two or more moving 



obstaclesfor exampleit is shown in drawing 22 arises. 

[0005]This shows the state where the moving obstacles 103 and 104 to which the 
mobile 102 which goes to the goal 101 comes from the front are avoidedas shown 
in drawing 22 and the black dot of the mobiles 102103and 104 makes legible the 
position for every 5 sampling time as an example. 

[0006]Although the mobile 102 has avoided the moving obstacle 103 in this 
examplethe state where it has collided at the point of x seal without the ability to 
avoid is shown. 
[0007] 

[Means for Solving the Problem]The 1 st invention is provided with a situation [ of 
identifying a specific situation based on the degree of near collision to two or more 
moving obstacles ] prediction deviceand an avoidance-control device which uses 
an algorithm for obstacle avoidance properly in order to solve such a technical 
problem. 

[0008]the 1st calculation for which the 2nd invention identifies a case where two 
or more object obstacles with which the degree of near collision exceeded the 1 st 
reference value exist — with a part, the 2nd calculation that identifies a case 
where two or more subjects in which distance with a subject exceeded the 2nd 
reference value exist — with a part, the 1st calculation — an obstacle with which 
the degree of near collision exceeded the 1 st standard in a part — those or more 
with twoand the 2nd calculation — with a decision means to conclude that it is an 
abnormal condition when there are two or more subjects in which distance with a 
subject exceeded the 2nd reference value in a part. It has a control section which 
changes an algorithm so that control which advances to a target spot in an 
abnormal condition may be repealed and it may be devoted to evasion of an 
obstacle. 
[0009] 

[Function]A specific situation is identified based on the degree [ as opposed to 
two or more moving obstacles in the 1st invention ] of near collisionand avoidance 
control which uses the algorithm for obstacle avoidance properly according to the 
discriminated result is performed. 

[0010]Control to which the 2nd invention disregards the goal and concentrates on 
evasion when the degree of near collision changes into the state where some two 
or more obstacles exist beyond in a predetermined value in addition to the 1st 
invention is performed. 
[0011] 

[Example] Drawing 1 is a block diagram showing one example of this invention. The 
composition of this deviceBased on the value of the near collision degree 
determining device 1 which asks for the degree of near collision of each of two or 
more obstacles and the mobile which can be set in a field with an obstaclethe 
situation [ of identifying a specific situation based on the degree of near collision ] 
prediction device 2and the near collision degree judging means 1 and the situation 
prediction device 2situation discernment and a control strategy. It is divided into 
the control device 3 which outputs the control command for avoiding an 



obstaclegoing to the determination of the avoidance operation used properlyi.e.an 
object. 

[0012]And the control device 3 suspends the control facility which tends toward a 
targetwhen there are two or more obstacles which have the danger beyond a 
predetermined value. 

[0013]The near collision degree determining device 1 as a means for acquiring the 
information about the obstacle in the field where a mobile advancesit has the 
positionthe speed and the direction-of-movement sensing device part 11 of an 
obstacle which detects the positionthe speedand the direction of movement (angle 
to a fixed targeted direction) of an obstacleand the signal conversion section 12 
which changes the detecting signal into the digital signal for data processing. 
[0014]It has the speed and the turning-angles metering device 13 of the self-car 
which measures the positionspeedand turning angles of the mobile concernedand 
the signal conversion equipment 1 4 which changes the measurement signal into 
the signal for data processing as a means for acquiring the information about a 
mobile. 

[0015]The multi-dimension member ship function storage parts store 15 which 
memorized the multi-dimension member ship function mentioned aboveAccording 
to the measurement signal from the speed and the turning-angles metering device 
13 of a self^vehicleit has the membership function automatic inverter 16 which 
changes automatically the multi-dimension member ship function stored in the 
multi-dimension member ship function storage parts store 15. 
[0016]In additionit has the near collision degree output unit 18 which outputs the 
value of CPU17 which calculates the degree of near collision with the output of 
the signal conversion equipment 12the output of the multi-dimension membership 
function storage parts store 1 5and the output of the situation prediction device 
2and the calculated degree of near collision, 

[0017]In the near collision degree determining device Ithe positionthe speedand 
the direction-of-movement sensing device 11 of an obstacle comprise an image 
sensor which detects a sizea positionetc. of the obstacle by light to the obstacle 
to the mobile which moves for examplein a flat-surface top. The signal conversion 
equipment 1 2 comprises an A/D converter which changes into a digital signal the 
signal about the obstacle sent from the positionthe speedand the direction-of^ 
movement sensing device 1 1 of the obstacle. 

[0018]The speed and the turning-angles metering device 13 of a self^vehicle 
comprise measuring instrumentssuch as a speedometer carried in the mobile 
which moves in a flat-surface topfor example. The signal conversion equipment 14 
is built into those measuring instrumentsor comprises an external A/D converter. 
[0019]The multi-dimension member ship function storage parts store 15 comprises 
a memory which memorizes the multi-dimension member ship function set up to 
the field where an obstacle tends to run including the variable which changes 
according to the speed and the direction of movement of a mobile like the after- 
mentioned. CPU17 and the near collision degree output unit 18 are controlled by 
the program which performs the below-mentioned near collision degree 



determining operation. 

[0020]the subject in whichas for the value memorized by the near collision degree 
storage parts store 31 the degree of near collision exceeds a reference value — 
calculation — the part 38 is supplied and the degree of near collision in this time 
calculates the number of the things beyond a predetermined valuefor exampleO.6 
or more thingsthere. the subject in which a self-vehicle and the distance between 
obstacles exceed a reference value — calculation — a self-vehicle and the 
distance between obstacles calculating the number of the obstacles which are 
beyond a reference valueand the part 39. The algorithm what kind of evasion the 
change algorithm storage parts store 40 of an evasion Argo rim should just 
perform with the number and value of an obstacle is memorized [ various ]. 
[0021]The control device 3 for avoidance operation is provided with the target 
arriving point position sensing device 32 which detects the position made into the 
attainment target of a mobileand the signal conversion equipment 33 which 
changes the detecting signal into the signal for data processing. 
[0022].Like.the after-mentionedan obstacle. The parameter for avoiding 
(movement speed and a direction of movement.) The shown angle. The algorithm 
to compute. The degree of near collision at present sent from the near collision 
degree output unit 1 8 of the degree of near collision before the current time spent 
from the direction of movement and the speed calculation algorithm storage parts 
store 34 for the stored evasionand the near collision degree storage parts store 
31 and the near collision degree determining device 1. And CPU35 which computes 
the parameter for avoiding an obstacle according to the algorithm stored in the 
direction of movement and the speed calculation algorithm storage parts store 34 
for evasion based on the target position detected with the target arriving point 
position sensing device 32It has control-command-outputting device 36 about the 
direction of movement which outputs the control command which realizes 
operation which avoids an obstacle from the parameter computed by this 
CPU35and speed. 

[0023]the subject in whichas for CPU37the degree of near collision exceeds a 
reference value — calculation — the subject in which the number of subjects in 
which the degree of near collision calculated in the part 38 exceeds a reference 
valueand a sell^vehicle and the distance between obstacles exceed a reference 
value — calculation — the self-car calculated in the part 39. The distance 
between obstacles corrects the algorithm of the change algorithm storage parts 
store 38 of an evasion algorithm with the algorithm memorized by the change 
algorithm storage parts store 40 of the evasion algorithm based on the number of 
subjects below a reference value. 

[0024]The situation [ where the situation prediction device 2 stored the algorithm 
which computes the degree of near collision in the time after this time (predicted 
value) like the after-mentioned ] prediction algorithm storage parts store 21 Based 
on the information (a detection value and measurement valuessuch as a position) 
about the obstacle and mobile which are sent from the near collision degree 
determining device 1 it has CPU22 which computes the predicted value of the 



degree of near collision according to the algorithm stored in the situation 
prediction algorithm storage parts store 21. The predicted value is sent to CPU17 
of the near collision degree determining device 1 . 

[0025]CPUs 172235and 37 contained in each of three means to constitute the 
obstacle avoidance device of drawing 1 comprise one CPU as hardwareand the 
program which performs each operation operation to the CPU is incorporated. The 
device constituted in this way is decided to avoid an obstacle by CPU37and an 
algorithm The decided algorithmAccording to the target position signal detected 
with the target arriving point position sensing device 32a predetermined operation 
is performed by CPU35and control in which the result avoids an obstacle via a 
direction of movement and the control-command-outputting device 36 about 
speed is performed. 

[0026]Operation by the algorithm which will disregard the goal by this composition 
if 0.6 or more obstacles have the two or more degrees of near collisionfor example 
will be performed, the subject in which drawing 2 is a block diagram showing other 
examplesand a self-vehicle and the distance between obstacles exceed a 
reference value from the thing of drawing 1 — calculation — the part 39 being 
omitted andin this casebased on the degree of near collision to two or more 
moving obstaclesthe situation where the situation prediction device 2 is specific is 
identified with the algorithm of the situation discernment algorithm storage parts 
store 40and avoidance control which uses the algorithm for obstacle avoidance 
properly with the control device 3 according to that discriminated result is 
performed. That isbased on the degree of near collision to a moving 
obstacleproper use of the control strategy for hindrance avoidance is performed. 
[0027]Since drawing 3 is an example which shows operation of the device of 
drawing If or exampleO.6 or more obstacles have the two or more degrees of near 
collisionA specific situation is identified with the algorithm of the storage parts 
store 40avoidance control which uses the algorithm for obstacle avoidance 
properly with the control device 3 according to the discriminated result is 
performedand the collision is avoided. 

[0028]In the explanationalthough more than "the method of avoidance operation 
and examination of the result" were explanation of this applicationin order to avoid 
becoming complicatedonly the portion required for an understanding was indicated 
and a detailed theory was omitted. Howeversince there is also a portion it is better 
to explain still in detail about a fine portionwhen requiredit is explained below that 
it can be referred to. 

[0029]Firstthe principle and method of asking for the degree of near collision in 
the near collision degree judging means 1 are explained. The multi-dimension 
member ship function corresponding to the field into which a mobile tends to 
advance first is set up. This is obtained as a dynamic multi-dimension member 
ship function by changing variously the parameter which determines the shape of 
the following multi-dimension member ship functions to the value which changes 
with situations. For examplethe three-dimensional member ship function which 
gives goodness-oMit linessuch as a parabola as shown in drawing 4 into the three- 



dimensional space which comprises x-y rectangular coordinates and goodness of 
fit is considered. 

[0030]The sign in a figure is defined as follows. Since it is easylet the starting 
point be a reference point (central point for describing a three-dimensional 
member ship function most briefly). 

F. (xyr/y) =0:. The parabola shape of **********. it can set to the function 
t^=f(x):x-t^ side to give — it hangs and can set to a bell type member ship function 
ty=g(y):y-ty side — hanging — bell type member ship function R,,: Radius Ryi of x 
shaft orientations of goodness-of-fit linessuch as a parabola form of the goodness 
of fit 1. Radius a^ of y shaft orientations of goodness-of~fit linessuch as a parabola 
form of the goodness of fit 1 : Parameter ay proportional to the fuzzy entropy 
about X : Parameter r^ proportional to the fuzzy entropy about y : arbitrary points 
(xy). Distance ry on [ of a goodness-of-fit linesuch as containingand a goodness- 
of-fit linesuch as the goodness of fit 1] a x-t^ section : A goodness-ofHIt linesuch 
as including arbitrary points (xy)and a goodness-oMit linesuch as the goodness of 
fit 1 Distance t on a y-ty section: After [ expedient ] the point (xy) given by a 
three-dimensional member ship function explains [ goodness-oMit ]divide the 
goodness of fit t into t^ and tyand describe itbut tt^and ty are the axes of 
coordinates same as a matter of fact. 

[0031] At this timea goodness-oMit linesuch as including arbitrary points (xy)is as 

follows. 

[0032] 

[Equation 1] 

[0033]The member ship function about t^ and ty becomes like the following (3) and 
(4) typesrespectively. Hereas for compound -in xx expresses the portion of a 
negative sideas for the portion by the side of rightand +. 
[0034] 
[Equation 2] 

[0035] 
[Equation 3] 

[0036]Since the distance of a goodness-of-fit linesuch as paying one's 
attentionand a reference point becomes R^+r^ and Ry+ry on a x-t^ section and a y- 
ty sectionrespectively[0037] 
[Equation 4] 



[0038] 
[Equation 5] 



[0039] 
[Equation 6] 



[0040] 
[Equation 7] 

Thereforeit is as follows from these. 

[0041] 

[Equation 8] 



[0042] 
[Equation 9] 

[0043]Unless the inside of 0 of the denominator of the 1st paragraph and the 2nd 
paragraph is the same form at this timeit cannot change into the explicit function 
about t. Thenthe following operations are performed. 
[0044] 

[Equation 10] 

[0045]The value of suitable s is chosen from the range of eye **** and 0 

<=s<=s,[0046] 

[Equation 1 1] 

[0047]Becoming d^ and dy are calculated. namely[0048] 
[Equation 12] 

[0049] 

[Equation 13] 



[0050]The function of goodness-o^-fit linessuch as eye ♦***is transformed like a 

following formula. 

[0051] 

[Equation 14] 



[0052]Hereas for compound Hn xx expresses the portion of a negative sideas for 

the portion by the side of rightand +. 

[0053] 

[Equation 15] 

[0054]The geometric meaning of this formula is shown in drawing 5 . It expresses 
that it is the shape which added and approximated the straight-line portion to the 
original parabola. (16) Formula[0055] 
[Equation 16] 

[0056] 

[Equation 17] 



[0057] 

[Equation 18] 

[0058]Howeverit calculates as y=dy at the time of x=d^ and |y|<dy at the time of 
|x|<d,. 

[0059]the case where a goodness-of-fit linesuch as paying one's attentionis in the 
outside of the parabola of the goodness of fit 1 like drawing 4 — 0 — inside 
becomes a positive value. 

[0060]Also when similarly there is a goodness-ofHlt linesuch as paying one's 
attentioninside the parabola of the goodness of fit Ithe completely same formula 
is obtained, however — when it exists in the straight-line portion of a goodness- 
of-fit line — arbitrary points (xy) approximated in this case — they are |x|<d,^ and 
|y|<dy — 0 — the time of inside becoming a positive value and being in a parabola 
portion — 0 — inside becomes a negative value. 

[0061] When the inside (or outside) of the parabola of the goodness of fit 1 
becomes a field of the goodness of fit 1 uniformlyit judges by the aforementioned 
conditions and a value is given. 

[0062] On the other handthe same effect as the case where the aforementioned 
three-dimensional parabola member ship function is used is acquired also by 
compounding the member ship function of a conventional type by goodness-ofHlt 
linessuch as a parabola forminstead of using the aforementioned three- 
dimensional parabola member ship function. Hereafterthe composite arithmetic for 
it is explained. 

[0063]Firstin the outside of the parabola of the goodness of fit lit is the goodness 
of fit of X and y. [0064] 
[Equation 19] 



[0065] 

[Equation 20] 
[0066] 

[Equation 21] 
[0067] 

[Equation 22] 

[0068]Similarlyit is about the inside of the parabola of the goodness of fit 1.[0069] 
[Equation 23] 

[0070] 

[Equation 24] 

[0071]Thereforea composite arithmetic type like [ these ] a following formula is 
obtained. 

[0072](A) In the case of by the side of a tip (y< 0)[0073] 
[Equation 25] 

[0074](B) In the case of by the side of reverse (y> 0) [0075] 
[Equation 26] 

[0076]<> It is a sign which shows composite arithmetic (for examplealgebra 
product). 

[0077]+ is [ the outside of the parabola of the goodness of fit 1 and - of a 
compound meaning ] the insides of the parabola of the goodness of fit 1 . 
[0078]Howeverit calculates as time ty=(ty) ^^^^ [ y / time t,=(t,) ..^x / x / lx|<d/ and / 
|y|<d]. the case where the compositing position to which its attention is paid is in 
the outside of the parabola of the goodness of fit 1 — 0 — inside becomes a 
positive value, moreover — when the compositing position to which its attention is 
paid is inside the parabola of the goodness of fit 1 and it is compounded in the 
straight-line portion of a goodness-of-fit linethey are |x|<d^ and |y|<dy — 0 — the 
time of inside becoming a positive value and being compounded in a parabola 
portion — 0 — inside becomes a negative value. 



[0079]When and ty become the goodness of fit 1 uniformly in y>-Ry and |x|<R^ 
(or y<"Ry|x|> R^)it judges by the above-mentioned conditions and a value is given. 
Namelyalso in the range of the goodness of fit 1 it compounds by asking for each 
goodness of fitassuming that it is that in which the above-mentioned member ship 
function exists. 

[0080]The same effect as the case where could compound the member ship 
function of the conventional type by goodness-olHlt linessuch as a parabola 
formand the above-mentioned three-dimensional parabola member ship function is 
used by the above-mentioned composite arithmetic type is acquired. That 
issetting out of the f^set which has the boundary shapes of a parabola form which 
were not conventionally made by this composite arithmetic method using the 
arithmetic unit which calculates the member ship function of a conventional type 
is attained. 

[0081]Nextthe case where the above-mentioned three-dimensional parabola 
member ship function and the member ship function of a conventional type are 
extended to a dimension (n+1) is explained. 

[0082]This is formation of a goodness-ofHIt sidesuch as being based on an ellipse 
paraboloid like drawing 6 . 

The following (n+1) dimension parabola member ship functions and a dimension 
(n+1) parabola composite arithmetic type are obtained. 

[0083] 

[Equation 27] 
[0084] 

HoweverO <=s<=Sk and Sk=min (R/a) 

It calculates as Xj=di at the time of d|=Ri-ais|xJ<di. 

[OO85]0 — the time of inside being positive — input-point outside 0 — the case 
where it is the input-point inside (A) tip side (x„<0) when inside is negativeand 
when it is all the |xj|<d|[0086] 
[Equation 28] 

[0087](B) In the case of by the side of reverse (x„>0) [0088] 
[Equation 29] 



[0089]+ is [ the outside of the paraboloid of the goodness of fit 1 and - of a 
compound meaning ] the insides of the paraboloid of the goodness of fit 1 . 
[0090] 

HoweverO<s<Sk and s,^=min (R/aj) 

It calculates as time ti=(ti) ^^^^i [ j / dj=R-a|s|xil<d]. 

[009 1]0 — the time of inside being positive — compositing position outside 0 — 



the time of being all the |x||<diWhen inside is negative — the compositing position 
inside [0092]About a three-dimensional thingit is as follows here. 
[Equation 30] 

[0093]When the position of the center of a parabola is [ the angle of (AB)and an 
axis ] phia following formula is obtained by movement of a three-dimensional 
member ship function. 
[0094] 

[Equation 31] 

[0095]howeverX= cos(x-A) phi+(y-B) sinphiY=-(x-A) sinphi+(y-B) cosphipsi - psi- 
phi — if it asks about the case of R,,=Ry=Os= Oand phi= 0 as simplest shape [0096] 
[Equation 32] 

[0097]It is expressed with this formulaand hangs and the shape of a bell type 
member ship function is shown in drawing 7 . 
[0098]Composite arithmetic type[0099] 
[Equation 33] 

[01 00] Composite chooses -when y is a right sideand when y is a negative side (tip 
side)it chooses +. 

[0101]It is as follows when it asks for the simplest shape in a dimension similarly 

(n+1). 

[0102] 

[Equation 34] 



[0103] 

[Equation 35] 

[01 04] Composite chooses -when x„ is a right sideand when x„ is a negative side 
(tip side)it chooses +. Herethe traveling vehicles 40such as a transportation 
vehicle which carries out the automatic travel of the flat-surface top as an 
example of a mobile as shown in drawing B are considered. This is constituted as a 
tricycle type mobile provided with the one front wheel 41 for a turnand the two 
rear wheels 42 and 43 for a drivefor example. The flat surface this traveling 
vehicle 40 runs is expressed with a x-y coordinate planeand that starting point is 
put on the position of the front wheel 41 of the traveling vehicle 40and let the 
direction in which the traveling vehicle 40 moves forward be the y-axis. 



[0105]In this casethe danger of the collision with the obstacle in the field (two- 
dimensional flat surface) into which the traveling vehicle 40 tends to advance can 
be expressed with the goodness of fit which the above hangs and is specified with 
a bell type parabola member ship function ( drawing 7) . That isthe degree d of near 
collision is expressed as follows from (34) types. 
[0106] 

[Equation 36] 

[0107]an upper type — X=+ — {x-f(v)sintheta} costheta+{y-fCv)costheta} 
sinthetaY=-{x"f(v)sintheta} costheta-Hy-f(v)costheta} costheta [0108]d: The 
degree of near collision (goodness of fit) 

f(v) : The maximum dangerous distance (distance from which danger is set to 1) 
f(v)=Av : The element A which makes a critical region large in proportion to the 
square of the speed v of the element f(v)=Av^±raveling vehicle which makes a 
critical region large in proportion to the speed v of a traveling vehicle: 
Proportionality constant (for exampleparameter used when adjusting according to 
the kind of load which an automatic conveying vehicle puts) 
theta: Turning angles (rudder angle of a front wheel) [clockwise rotation is made 
positive] 

a^ayi The parameter which adjusts the size of a critical region [0109]If it asks for 
the degree d of near collision in the field to which the traveling vehicle 40 tends to 
advance by the above-mentioned formula (38)it will become like drawing 9 and 
drawing 10 . The line (grade goodness-of-fit line) with the same degree of near 
collision is expressed in these figures by the parabola by using the above three- 
dimensional parabola member ship functions. The degree [ as opposed to / when 
there is the obstacle 50 which moves into the field of a graphic display / the 
obstacle 50 ] of near collision is expressed with d=0.4)when the value of a 
goodness-of^fit linesuch as crossing the obstacle 50is (drawing 9 and it is d= 0.2 
and drawing 10 . 

[0110]Nextthe degree of near collision to the above-mentioned moving obstacle 
50If it shall be detected for every predetermined sampling time dt and sampling 
time t=to and 1 time ago is made into t=t.i for a certain time (current time)Drawing 
9_expresses near collision degree d,, in t=t.,and drawing 1 0 expresses near 
collision degree do in t=to. The degree of near collision called for in each sampling 
time is stored in the near collision degree storage parts store 31 of drawing 1 . 
[01 1 1]When sampling time 1 time after current time to is made into t. drawing 1 1 
and drawing 12 express near collision degree (predicted value) d, in t,=to+dt. 
Hereafterhow to calculate this predicted value d, is explained. 
[01 12]Although the above-mentioned moving obstacle 50 changes a direction of 
movement and speed at random by limited within the limitsHerethe position of the 
moving obstacle 50 in ti=to+dt is searched forassuming once that linear uniform 
motion is carried out to the direction of movement in this time t=to at the rate of 
simultaneous point t=to. Nextit asks for the ellipse form fuzzy field of the size 



which is proportional to the migration length between t, from t^ focusing on the 
position. The meaning of this ellipse form fuzzy field expresses an ambiguous field 
[ say / "in t=t,=to+dtthe moving obstacle 50 will come around here" ]. At this 
timean ellipse form fuzzy field is given with the three-dimensional member ship 
function of a following formula. 
[0113] 

[Equation 37] 

[0114]It is an upper type and is X=+(x-Xp) cospsi+(y-yp) sinpsiY=-(x-Xp) sinpsi+(y- 
yp) cospsi. [01 15]X-coordinate yp of the position in t=to+dt at the time of assuming 
that the goodness-of-fit Xpimoving obstacle to the member ship function of the 
fuzzy label "it will come around here" carries out linear uniform motion : p: A 
moving obstacle linear uniform motion. Thenthe y-coordinate of the position in 
t=to+dt at the time of assuming [0116]ap^ and a^^: Direction of movement (angle to 
the X side) of the moving obstacle in speed psi:t=t o of the moving obstacle in 
parameter Vp:t=to which determines the size of an elliptic region 
[01 17]In this caseit is assumed that a it (traveling vehicle 40) also does linear 
uniform motion between t=to+dt(s) from t=to.About their linear uniform motionthe 
speed in t=to and the direction (angle) in which only the specific amount which 
tends to go to a target arriving point corrected the direction of movement in t=to 
are used. [ this ] 

[0118]And when goodness of fit becomes the maximum in the overlapping portion 

of the three-dimensional parabola member ship function with which a critical 

region is expressed as mentioned aboveand the three-dimensional ellipse member 

ship function which gives the position of a moving obstaclethe maximum goodness 

of fit is made into predicted value d^ of the degree of near collision. 

[01 19]Nextthe overall evaluation value D is calculated with a following formula 

from near collision degree d,, in above the three degrees of near collisioni.e.t=t, 

^near collision degree dp in t=toand near collision degree (predicted value) d, in 

t=to+dt. 

[0120] 

[Equation 38] 

[0121]The 2nd paragraph and the 3rd paragraph of an upper type serve as a 
meaningful big valueonly when d.^doand d, become a value respectively near Ibut. 
Since the parabola member ship function expresses the critical regionwhen an 
obstacle continues existing in the position near its front as a resultit becomes a 
value which cannot disregard the 2nd paragraph and the 3rd paragraph. 
[0122]Nextthe procedure of asking for the control command for collision avoidance 
is explained. As for the method of the evasionthere is following the 2 passage. 
[0123]One is a case where the point (position of a moving obstacle) P of giving 
predicted value d^ of the degree of near collision in t=to+dt does not pass through 



a oneself (traveling vehicle 40) frontas shown in drawing 1 1 . 

Another is a case where the point P passes as shown in drawing 12 . 

In the former (drawing 11 ) examplehe changes direction into the left and he takes 

the method of passing through an obstacle front by gathering speedand in the 

latter ( drawing 12 ) examplehe changes direction into the right and he takes the 

method of turning after an obstacleby lowering speed. 

[01 24] Although the example of drawing 9 and drawing 10 is a case where the 
member ship function of a parabola form is applied to the field into which a mobile 
tends to advancea member ship function with a goodness-ofHlt linesuch as not 
only this but other shapemay be used for it. As the examplewhen an ellipse 
member ship function is usedit is as follows. 

[0125]In this casesince the technique of asking for an ellipse member ship function 
is the same as that of the case of the above-mentioned parabola 
fundamentallyintermediate explanation is omitted and shows a result. 
[0126]As mentioned abovein the case where the direction which expresses with a 
x-y coordinate plane the flat surface the traveling vehicle 40 runsand puts the 
starting point on the position of the front wheel 41 of a traveling vehicle and in 
which the traveling vehicle 40 moves forward is made into the y-axisThe degree of 
near collision in the field (two-dimensional flat surface) into which the traveling 
vehicle 40 tends to advance can be expressed with the goodness of fit specified 
with a triangle type ellipse member ship function as shown in drawing 13 and 
drawing 14 . That isthe degree d of near collision is expressed as follows. 
[0127] 

[Equation 39] 

[0128]X=+x cos theta+y sinthetaY = the formula (41) of the -x sin theta+y cos 
theta above can express the degree of near collision in a critical region by a 
goodness-oMlt linesuch as elliptical. 

[0129]As shown in drawing 1 S while a parabola member ship function estimates the 
danger in the critical region of its (traveling vehicle 40) frontit can be evaluated by 
an ellipse member ship function about its back. 

[0130]Nexta moving obstacle explains two or more (n) ****** case. 
[0131]When aimed at the i-th moving obstacle (i= 1 2....n)correction rudder angle 
(correction of rudder angle theta of front wheel) thetajN for avoiding the collision 
with oneselves (traveling vehicle 40) is given with a following formula. 
[0132] 

[Equation 40] 

[0133]It is an upper type and they are thetaA=RcT Dj (Rct is a proportionality 
constant). 

theta^: Avoiding-angles thetao: The angle of deflection of a target position 
[0134]di,: The degree of near collision in time ti=to+dtto an i position moving 



obstacle (predicted value) 

D| : When avoiding + on the right among overall evaluation value compound ** of 
the degree of near collision to the i-th moving obstacle- is a case where it avoids 
on the left. 

[0135]Correction rudder angle thetaj^ to that (it is considered as the i-th moving 
obstacle) from which the overall evaluation value D becomes the maximum among 
the moving obstacles which he has to avoid on the right when aimed at n moving 
obstaclesThe overall evaluation value D takes the weight average about D with 
correction rudder angle theta,,N to what becomes the maximum (it is considered as 
the k-th moving obstacle) among the moving obstacles which he has to avoid on 
the left. 

[0136]That iscorrection rudder angle theta^, for the evasion to n moving obstacles 

is calculated with a following formula. 

[0137] 

[Equation 41] 

[0138]It accelerates by slowing down in proportion to the overall evaluation value 
D similarly about correction of speed. What is necessary is Just to take a weight 
average by the overall evaluation value Dwhen aimed at n obstacles. Actuallyspeed 
is kept from changing from a certain fixed speed not muchand can mainly realize 
evasion by the above-mentioned rudder adjustment. 
[0139]The algorithm of (40) types is changed as follows by a situation. 
[Equation 42] 

[0140]In the case of n= 3 (i.e.when there are the three moving obstacles ABand C 
in the field to which the traveling vehicle 40 which goes to the target position 
alpha advances) drawing 16 - drawing 1 9 show the temporal response of the 
avoidance operation to those obstacles. In these figuresthe small circle located in 
a line one by one shows the traveling vehicle 40 for every time of a samplingand 
the position of the three moving obstacles ABand C. A black dot shows the 
position in the time. As for drawing 21 and drawing 22 a moving obstacle shows the 
example of the avoidance operation of one case (A' shows)respectively. 
[0141]From these examples of a simulationaccording to the above-mentioned 
evading methodwhile the traveling vehicle 40 avoided well 1 or two or more moving 
obstacles ABand Cit was proved that it could arrive at the target position 101. 
[0142]As mentioned abovealthough the example of the graphic display was 
describedthis invention is not restricted to this. For examplea member ship 
function is a three dimension when the field where a mobile advances like an 
example is a two-dimensional flat surfacebut when moving a three dimension like a 
flight thinga 4-dimensional member ship function is used. The member ship 
function of arbitrary dimensions and shape is used if needed. Obstacles may be 
any of a static object and a mobile. 



[0143] 

[Effect of the Invention]As explained abovethis invention identifies a situationand 
since it used the evasion strategy properlyit has the effect that the inconvenience 
which collides by an unsuitable evasion strategy does not occur. 



DESCRIPTION OF DRAWINGS 



[Brief Description of the Drawings] 

[Drawing 1] It is a block diagram showing the composition of one example of this 
invention. 

[Drawing 2] It is a block diagram showing the composition of other examples of this 
invention. 

[Drawing 3] It is a figure for explaining the effect of this invention. 
[Drawing 4] It is a figure showing a three-dimensional parabola membership 
function. 

[Drawing 5] It is a figure in the case of becoming the shape which added the 
straight-line portion to the three-dimensional membership function of drawing 4 . 
[Drawing 6] It is a figure for the elliptic paraboloid which forms goodness-ofHlt 
sidessuch as a multi-dimension membership functionto be shown. 
[Drawing 7] It is a figure showing the shape of a temple bell form three-dimensional 
parabola membership function. 

[Drawing 8]I t is a figure showing the physical relationship on the coordinate plane 
of a mobile. 

[Drawing 9] It is the figure which expressed the degree of near collision at the time 
of a sampling 1 time ago in the field in which a mobile advances. 
[Drawing 10] It is the figure which expressed the degree of near collision at present 
in the field in which a mobile advances. 

[Drawing 11] It is the figure which expressed the degree of near collision at the 
time of a sampling 1 time after in the field in which a mobile advances. 
[Drawing 12] It is a figure showing the predicted value of the degree of near 
collision in case an obstacle passes. 

[Drawing 13] It is a figure showing the example of a three-dimensional membership 
function. 

[Drawing 14] It is a figure showing the example of a triangular three-dimensional 
membership function. 

[Drawing 1 5] It is the figure which expressed the degree of near collision using the 
ellipse membership function in the field behind a mobile. 

[Drawing 1 6] It is a figure showing the example of the avoidance operation to three 
moving obstacles. 

[Drawing 1 7] It is a figure showing a continuation of the avoidance operation of 
drawing 1 6 . 

[Drawing 1 8] It is a figure showing a continuation of the avoidance operation of 
drawing 16 . 



[Drawing 19] It is a figure showing a continuation of the avoidance operation of 

drawing 16 . 

[Drawing 20] lt is a figure showing the example of the avoidance operation to one 
obstacle movable matter. 

[Drawing 21] The figure showing other examples of the avoidance operation to one 
obstacle movable matter 

[Drawing 22] It is a figure showing the example of ****** of a device 

conventionally. 

[Description of Notations] 

1 Near collision degree determining device 

2 Situation prediction device 

3 Control device 

1 1 A positionspeedand a direction-of^movement sensing device of an obstacle 
1214and 33 Signal conversion equipment 

13 Speed and a turning-angles metering device of a self-vehicle 

1 5 Multi-dimension membership function storage parts store 

16 Membership function automatic inverter 
172235 CPU 

18 Near collision degree output unit 

21 Situation prediction algorithm storage parts store 

31 Near collision degree storage parts store 

32 Target arriving point position sensing device 

34 The direction of movement and speed calculation algorithm storage parts store 
for evasion 

36 It is a ********** output unit to a direction of movement and speed. 

38 the subject in which the degree of near collision exceeds a reference value 
calculation — a part 

39 the subject in which a self-vehicle and the distance between obstacles exceed 
a reference value — calculation — a part 

40 The change algorithm of an evasion algorithm 



